匀速（末端线速率）应用调试文档

[TOC]

1 简介

对于有匀速（末端线速率）需求的应用：如涂胶等，软件需要进行如下设置：

1.关闭动态调速使能标志 dynamic_adjust_motion_constraints

2.使用只规划位置方式 ONLY_POSITION_PLAN

3.如果运动过程中报关节速度超限，则需要降低目标线速度

4.如果运动过程中发现某些地方有速度波动的情况，则需要增大线加速度

5.如果运动过程中发现某些地方姿态旋转方向明显和期望不一致或者姿态变化远大于期望值，则需要调整起始关节角，让机械臂在其关节范围内能够连续变化

６.如果加速度增大了，机械臂末端抖动明显（一般是关节加速度太大），则需要降低目标线速度，并将加速度回退

以上情况如能保证，最后得到的运动轨迹应该就是匀速轨迹。

根据以往的经验来看，限制匀速运动的因素主要是关节速度和加速度，如果用户设置的路点姿态变化均匀，且线加速度设置合适的情况下，可以得到一个末端线速率较大的匀速运动。

2 调试示例

以涂胶应用为例，参数与曲线如下（左图笛卡尔空间，右图关节空间）：

// 用户输入的全局约束
maxJV = {1.62316, 1.62316, 3.10669, 3.11049, 3.11049, 3.11049};
maxJA = {6.45772, 6.45772, 20.944, 31.1049, 31.1049, 31.1049};
maxCV = {2, 5};
maxCA = {10, 10};

// 运动属性
path_property.maxV = {0.3, 1};
path_property.maxA = {1.2, 1.2};

• 根据速度曲线可以看出，六关节速度超出了全局限制：3.11049m/s（现象是目标关节速度超限），需要降低目标线速度，如降低为0.25m/s，调整后曲线如下：

• 调低目标线速度后六关节速度保持在全局限制范围内，但是通过左图（绿色线）看到并不能达到匀速效果（现象是非匀速），需要调大目标线加速度，将线加速度增大至6m/s^2^，调整后曲线如下：

• 可以从图中看到可以达到匀速效果，并检查关节加速度是否大幅度超限（现象是机械臂末端抖动明显），若有抖动现象，需要将加速度回退，按照小幅度调整线加速度以保证最后得到的运动轨迹是匀速轨迹